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APPARATUS FOR DETECTING LOCATION OF MOVABLE BODY IN 
NAVIGATION SYSTEM AND METHOD THEREOF 

PRIORITY 

This application claims priority to an application entitled "Apparatus For 
Detecting Location Of Movable Body In Navigation System And Method Thereof filed 
in the Korean Industrial Property Office on March 14, 2003 and assigned Serial No. 
2003-16090, the contents of which are hereby incorporated by reference. 

BACKGROUND OF THE INVENTION 

1. Field of the Invention 

The present invention relates to a navigation system, and more particularly to an 
15 apparatus and method for detecting a location of a movable body such as a car in 
navigation system. 

2. Description of the Related Art 

Typically, a car navigation system provides a driver with current location 
20 information of the car and an optimum route to destination and guides the driver 
according to a traveling route. The most basic function of the car navigation system is 
to accurately determine a current location of the car. 

FIG. 1 is a schematic constructional view of a conventional navigation system, 
25 which mainly illustrates a construction necessary for measuring a current location of a car 
in a car navigation system. Referring to FIG. 1, a typical car navigation system includes 
a GPS sensor 10, a dead reckoning (DR) sensor 20, a map data storage 30, a current 
location detector 40 and a display 50. 

30 The map data storage 30 stores a digital map. FIGs. 2a and 2b illustrate a 

conventional method of storing map data. Typically, for rapid search in map data, a 
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total map is divided into a plurality of parts, known as "map sections", of a 
predetermined unit size, and road information is displayed by means of nodes and links in 
each of the map sections. FIG. 2a shows a map of South Korea, which is divided into 
12 map sections, and FIG. 2b shows one of the 12 map sections, in which road 
5 information is displayed with nodes and links. 

The GPS sensor 10 is a sensor for receiving a Global Positioning System (GPS) 
signal. In the present example, GPS implies a system for tracing a global location by 
means of 24 artificial satellites orbiting at a height of about 20,183km. That is, GPS is a 

10 satellite navigation system in which a GPS receiver installed on an observational station 
receives the radio wave transmitted from a satellite, the accurate location of which is 
known, so that the time necessary in receiving a radio wave is calculated, thereby 
obtaining a location of the observational station. The GPS sensor 10 receives the GPS 
signal and transmits location information using geometric coordinates x, y, z, and current 

1 5 time information t of a car to the current location detector 40. 

The DR sensor 20 is a sensor detecting its own relative location and moving 
direction by means of previous location information. Typically, the DR sensor may be 
divided into a sensor for measuring a distance traversed, for instance, speedometer, 
20 odometer, accelerometer, etc., and a sensor for measuring an angle of rotation, for 
instance, geomagnetic sensor, gyro, etc. Accordingly, the DR sensor 20 senses a 

velocity v and a moving direction 0 of a car and transmits it to the current location 

detector 40. 

25 The current location detector 40 extracts map data of a corresponding region, on 

the basis of location information of the car transmitted from the GPS sensor 10 and the 
DR sensor 20 and performs map-matching for location information of the car using map 
data. That is, the current location detector 40 indicates a location of a user on 
previously constructed map data, known as a "digital map", and confirms the location of 

30 the car with one point on the map. Further, as a result of the confirmation, the current 
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location detector 40 computes location information of the car and displays the location 
information through a display 50. 

In the present example, typically, since the GPS sensor 10 and the DR sensor 20 
5 include an error in the measured value, the current location detector 40 performs map- 
matching to correct the error. For instance, the GPS sensor 10 may have errors such as 
ionization layer delay error, satellite clock error, multi-path and the DR sensor 20 may 
have an initial alignment error and a conversion factor error. Particularly, when the car 
passes high buildings, trees, tunnels, etc., the car may not sufficiently receive the GPS 

10 signal and thus the error becomes larger. Also, when the error is accumulated, it is 
difficult for the current location detector 40 to accurately determine the location of the car. 
When location information of the car measured using sensors, which have errors as 
described above, is indicated on a map, the location information does not agree with the 
actual location of the car. Accordingly, in order to correct errors, a typical current 

1 5 location detector 40 performs map-matching using a digital map. 

FIG. 3 illustrates the current location detector 40, typically the current location 
detector 40 includes a sensor 41, a map data detector 42, a memory 43, a filter 44 and a 
map-matching unit 45. The sensor 41 receives sensor data, for example, x, y, z, t, v and 

20 0 , from the GPS sensor 10 and the DR sensor 20, and transmits the car location 

coordinate information x, y for detecting a map data from among the sensor data x, y, z, t, 

v and 0 to the map data detector 42. The map data detector 42 extracts map data of a 

corresponding region from the map data storage 30 on the basis of the location 
information x, y and stores it in the memory 43. 

25 

The filter 44 receives location coordinates x, y, and time t, velocity v and angle 

0 of the car and computes an optimum location x\ y' and angle 0 ' using the values as 

measured value of the filter. The filter 44 typically uses a GPS/DR integrated Kalman 
filter combining GPS and DR. Since the Kalman filter mathematically minimizes a 
30 measured error of a variable and has a characteristic of being suitable for computation 
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and prediction of the variable, it is known as a prediction filter. Furthermore, the 
Kalman filter can predict the optimum state even under an error circumstances. 
Accordingly, the Kalman filter is typically used in order to minimize a measured error of 
a sensor in the car navigation system. 

5 

The characteristic of the Kalman filter, values x\ y' and 9 'computed by the 

filter 44 do not agree with an actual map line, owing to the error of the GPS sensor 10 
and the DR sensor 20. The map-matching unit 45 performs map-matching using the 

values x\ y' and 0 'computed by the filter 44 and the digital map stored in the memory 

10 43 in order to correct the error. That is, the map-matching unit 45 corrects the computed 

location by matching the values x\ y' and 9 'computed by the filter 44 on the digital 

map. 

The filter 44 and feed back location coordinates 5 x , 5 y , velocity 5 v and an 

15 angle 5 9 information of the car outputted from the filter 44, in order to correct the 

error of the DR sensor 20 on the basis of GPS data, providing a relatively accurate 
location information in comparison with the DR sensor 20. Further, the filter 44 
receives the location/angle of a car matched from the map-matching unit 45 and a 

difference in location and angle, that is, A x, A y and A 9 computed by the filter 44, 

20 and corrects the GPS/DR integrated Kalman filter in the filter 44. 

A conventional method for detecting a current location of a car in a car 
navigation system is described with reference to FIG. 4a. When the location coordinate 
information x, y, z and time t of the car received by the GPS sensor and the velocity v and 

25 direction information 9 of the car sensed by the DR sensor 20 (FIG. 1) are inputted in 

step S10, the car navigation system detects a region corresponding to the sensor data x, y, 

z, t, v and 9 from the pre-stored digital map, as discussed with reference to FIGs. 2a 
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and 2b, and stores it separately in memory 43 (FIG. 3 in step S20. In step S30 the car 
navigation system initializes the GPS/DR integrated Kalman filter model for computing 
the location information of the car using the sensor data, then the car navigation system 
computes the location information of the car using the sensor data as measured value of 
5 the GPS/DR integrated Kalman filter in step S40. 

Typically the GPS sensor 10 (FIG. 1) and the DR sensor 20 (FIG. 1) include an 
error within the measured value, the location computed by the GPS/DR integrated 
Kalman filter model is not accurate owing to the error included in the GPS sensor 10 
10 (FIG. 1) and the DR sensor 20 (FIG. 1). In order to solve this problem, the GPS sensor 
and the DR sensor correct the error of GPS sensor and the DR sensor by feedback data of 
the measured data in step S50. In this case, the data being fed back to the GPS/DR 

integrated Kalman filter 44 (FIG. 3) is the location coordinates 6 x, 5 y, velocity 5 v 

and angle 5 9 information of the car outputted from the GPS/DR integrated Kalman 
15 filter. 

Further, in step S60, the location information computed in step S40 is map- 
matched using the digital map about region corresponding to the sensor data stored in 
step S20. In step S70, the GPS/DR integrated Kalman filter is corrected using the map- 
20 matching result. That is, the GPS/DR integrated Kalman filter is corrected using filter 

correction data A x, A y and A 0 generated by the map-matching result. 

FIG. 4b illustrates a process flow of the map-matching step S60 (FIG. 4a). In 
step S61, link information and node information are detected from the map, which is an 

25 object of map-matching, that is, a digital map stored in step S20 (FIG. 4a). In step S62, 
it is judged whether the location computed in step S40 (FIG. 4a) on the basis of the link 
information and node information is a crossroads. In judging whether the computed 
location is a crossroads, an existence of a crossroad within a predetermined distance may 
be detected using a forward node information and link information. It can be 

30 determined that the computed location is a crossroads, when a trace of the car calculated 
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from the GPS/DR integrated filter passes a node of the crossroads or when a measured 
attitude angle has a large difference from a direction angle of the current computed road, 
without regard to that the trace has not passed yet, or has already passed. 

5 From the judgment in step S62, if the location computed in step S40 (FIG. 4a) is 

a crossroads, a link of an adjacent crossroads is selected in step S63. If not, a link of the 
shortest distance from the computed location is selected in step S64. In this case, the 
selected link becomes matched map information for the computed location information. 

10 As described above, when the map-matching has been performed about the 

computed location information, x and y coordinate corresponding to the matched link are 
calculated in step S65. In step S66, a difference between the x and the y coordinate 
included in the computed location information and the x and the y coordinates calculated 
in step S65 are outputted as filter correction data. The filter correction data is a 

15 difference, A x, A y and A 0 , between a location/angle of the car matched in step S63, 

S64 and a location/angle computed in the filter 44. The error of the GPS/DR integrated 
Kalman filter is corrected using the outputted filter correction data in step S70 (FIG. 4a). 

FIG. 5 shows an example of a method for correcting a location of a car by 
20 conventional method in a car navigation system, or in other words, correcting location 
information computed through the GPS/DR integrated filter by means of map-matching. 
Circles represent location information computed by the GPS/DR integrated filter and 
straight lines represent the matched location information. 

25 First, a forced correction of the attitude angle and location of the car is 

implemented for general traveling. For instance, when it is judged that a car is traveling 

along a bridge, a tunnel, or a long, straight road, the attitude angle AG of the car is 

adjusted, since it can be said that the attitude angle of the map-matched car is corrected. 

As shown in FIG. 5a, since an error of 'A y' is generated when the car is traveling on a 

30 horizontal road, the value c y' computed in the GPS/DR integrated filter is corrected by 
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the difference 'A y\ Further, as shown in FIG. 5b, since an error of 'A x' is generated 
when the car is traveling on vertical road, the value 'x' computed in the GPS/DR 
integrated filter is corrected by the difference *A x\ Also, as shown in FIG. 5c, when 
the car passes a crossroads, the location of the car is corrected to the intersection by the 
5 difference 'A x and A y\ 

A conventional current location detection apparatus and method thereof using 
the aforementioned correction method for attitude angle, can not adjust an absolute 
location of a car and a forced correction method in the vertical and horizontal directions 

10 includes error and uncertainty. Further, the conventional current location detection 
apparatus and method thereof can perform a location correction only in limited cases, for 
instance, when the car continuously travels on straight line direction during a 
predetermined time or passes a crossroads. That is, since the conventional method can 
perform a sensor correction only in limited section, a real-time location correction in a 

15 car navigation system requiring constantly accurate location has been impossible. 
Accordingly, the current location detection apparatus and method thereof can not 
accurately detect a location of the car. 

Further, in order to correct the error of the GPS sensor/DR sensor and compute 
20 the location information of a car, a typical centralized Kalman filter has been used in the 
prior art. In the present example, the centralized Kalman filter can most easily realize 
an optimum filter when the order of the equation used for implementing the system is low. 
However, when the order of the equation used for implementing the system is high, it is 
difficult for the centralized Kalman filter to calculate in real-time since the calculation 
25 load of an inverse matrix and co variance matrix increases. Further, when a sensor is out 
of order, the centralized Kalman filter can judge it to be out of order only after measured 
value taken from several sensors is processed. Accordingly, it is difficult for the 
conventional prior art to prevent an erroneous measured value from affecting a computed 
measured value for the location information of the car. 

30 
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SUMMARY OF THE INVENTION 

Accordingly, the present invention solves the above-mentioned problems 
occurring in the prior art, and it is an object of the present invention to provide a method 
5 and an apparatus for accurately detecting a location of a movable body in a car navigation 
system. 

It is another object of the present invention to provide a method and an apparatus 
for detecting a location of a movable body, which can improve an accuracy of location 
10 determination of a movable body by means of prediction and real-time correction of 
sensor information using limitation filter whenever the sensor information including an 
error is inputted, after composing a linear model using a map information with the 
limitation filter. 

15 It is a further object of the present invention to provide a method and an 

apparatus for detecting a location of a movable body, which can detect a location of a 
movable body including road error on the basis of a digital map. 

It is yet another object of the present invention to provide a method and an 
20 apparatus for detecting a location of a movable body, which can improve an accuracy of a 
location determination of a movable body by means of distributed processing of error 
correction process of sensor for detecting a location of the movable body. 

In order to accomplish these objects, according to the preferred embodiment of 
25 the present invention, there is provided an apparatus for detecting location of a movable 
body comprising: a map data detector for detecting a map information of region 
corresponding to a location information from external digital map storage on the basis of 
the location information of the movable body transmitted from sensors sensing the 
location and traveling information of the movable body; a memory for storing the map 
30 information detected from the map data detector; a filter for computing an optimum 
location of the movable body including road error included in the map information on the 
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basis of the location and traveling information of the movable body transmitted from the 
sensors; and a map-matching unit for receiving the optimum location information of the 
movable body from the filter and correcting the optimum location information by 
matching the optimum location information and the map information stored in the 
5 memory. 

In order to accomplish these objects, according to the preferred embodiment of 
the present invention, there is provided a method for detecting a location of a movable 
body comprising the steps of: 1) detecting and storing a map information corresponding 

10 to a location information in response to location and traveling information of a movable 
body received from sensors sensing a location and traveling information of the movable 
body, and initializing a GPS/DR filter model; 2) computing a first location information of 
the movable body on the basis of the GPS/DR filter model; 3) matching the first location 
information with the stored map information, and extracting a road linear information at 

1 5 which the movable body is located, on the basis of the first location information and the 
matched map information; 4) initializing a map constraint filter model on the basis of the 
traveling information of the movable body sensed by the sensors and the road linear 
information extracted in step (3); 5) computing a second location information of the 
movable body including an road error on the basis of the map-limited filter; 6) computing 

20 an optimum location information of the movable body on the basis of the first location 
information of the movable body computed in step (2) and the second location 
information of the movable body computed in step (5) ; 7) generating a filter correction 
data for correcting a state and an error of the GPS/DR filter model and the map constraint 
filter model on the basis of the computed result in step (6); and 8) correcting the state and 

25 error of the GPS/DR filter model and the map constraint filter model by means of the 
filter correction data. 
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BRIEF DESCRIPTION OF THE DRAWINGS 

The above and other objects, features and advantages of the present invention 
will be more apparent from the following detailed description taken in conjunction with 
5 the accompanying drawings, in which: 

FIG. 1 is a block diagram showing an approximate construction of a 
conventional car navigation system; 

FIG. 2 is a block diagram illustrating a conventional storage method of map 

10 data; 

FIG. 3 is a schematic diagram for a conventional current location detector in a 
car navigation system; 

FIG. 4a is a flow chart of a conventional method for detecting a current location 
of a car in a car navigation system; 
1 5 FIG. 4b is a flow chart of a conventional method for map matching used in a car 

navigation system; 

FIG. 5 is a diagram showing an example of a method for correcting a location of 
a car by the conventional method in a car navigation system 

FIG. 6 is a schematic diagram of a location detector in a car navigation system 
20 according to an embodiment of the present invention; 

FIG. 7 is a flow chart illustrating an operation of a first filter included in a 
current location detector in a car navigation system according to an embodiment of the 
present invention; 

FIG. 8a is a flow chart illustrating an operation of a second filter included in a 
25 current location detector in a car navigation system according to an embodiment of the 
present invention; 

FIG. 8b is a graph showing a relationship between an error(vm) of map 
information and a width of a road; 
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FIG. 9 is a flow chart illustrating an operation of a third filter included in a 
current location detector in a car navigation system according to an embodiment of the 
present invention; 

FIG. 10 is a flow chart of an operation of map-matching unit included in a 
5 current location detector in a car navigation system according to an embodiment of the 
present invention; and 

FIG. 1 1 is a flow chart of a method for detecting location of a car according to 
an embodiment of the present invention in a car navigation system. 

1 0 DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENT 

Hereinafter, the preferred embodiments of the present invention will be described 
with reference to the accompanying drawings. In the following description of the 
present invention, a detailed description of known functions and configurations 
15 incorporated herein will be omitted when it may make the subject matter of the present 
invention rather unclear. 

FIG. 6 is a block diagram of a location detector 400 in a car navigation system 
according to one embodiment of the present invention, the location detector 400 
20 comprises a sensor 410, a map data detector 420, a memory 430, a filter 440 and a map- 
matching unit 450. The sensor 410 receives sensor data, for example, coordinates x, y, z, 

time t, velocity v and angle 0 from the GPS sensor 10 and the DR sensor 20, and 

transmits the location coordinates information x, y for detecting map data among the 

sensor data x, y, z, t, v and 0 to the map data detector 420. The map data detector 420 

25 extracts map data of the corresponding region from the map data storage 30 on the basis 
of the location coordinates information x, y and stores it in the memory 430. 

The filter 440 receives a location coordinates x, y, time t, velocity v and angle0 
of the car, and computes optimum location coordinates x", y" and angle 0 " using the 
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values as measured value. The filter 440 consists of a plurality of filters 441, 442, 443. 
The filter 440 consists of a distributed layer type Kalman filter, that is, a combined type 
Kalman filter. The filter 440 consists of a first filter 441, for example, a GPS/DR filter, 
for computing first location information of the car from the sensor data, a second filter 
5 442, for example, a map-constraint filter, computing second location information of the 
car from linear information of the road transmitted from the map-matching unit 450, and 
a third filter 443, for instance, a master filter, which includes the first filter 441 and the 
second filter 442 integrated with each other. 

10 The map-matching unit 450 matches the values x", y" and 0 " computed in the 

filter 440 with the digital map in order to correct the computed location. Further, the 
map-matching unit 450 extracts road linear information including road error from the first 
location information of the car computed by the first filter 441 and transmits it to the 
second filter 442. Here, the road linear information including the road error means a 
1 5 width of the actual road on which the car is traveling. 

FIG. 7 to FIG. 10 are flow charts illustrating operation of the first filter 441, the 
second filter 442, the third filter 443, and the map-matching unit 450. Referring to FIG. 
6 and FIG. 7, the operation of the first filter 441 is described. 

20 

First, the first filter 441 receives sensor data, for example, location coordinates x, 

y, time t, velocity v and direction angle 0 information of the car, from the sensor 410 in 

step SI 10, and initializes the GPS/DR filter model for computing the first location 
information of the car using the sensor date as measured value in step SI 20. The 
25 GPS/DR filter model initialized in step S120 is shown in Equation 1. 

[Equation 1] 

Z k =H k x k +v k ,v k ~N(0 9 G k ) 
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In Equation 1, x represents an equation of the state of the system (GPS/DR 
model) at time t, 0 represents the GPS/DR model, known as system, for computing 
location, W represents an error of the system model and N(0, Qk) represents a distribution 
Q k and average 0 of the system error. Z represents an equation of a measured model, H 
5 represents the measured model, v represents an error of the measured model, and N(0, 
Gk) represents a distribution Q k and average 0 of the measured model error. 

As described above, when the GPS/DR filter model is initialized, the first filter 
441 applies the sensor data to the GPS/DR filter model of the Equation 1 in order to 

10 compute the first location information xF, yF and 9 1' of the car in step SI 30. In step 

S130, a method for computing the first location coordinate information xF, yl' and 0 F 
is shown in Equation 2. 

[Equation 2] 

Referring to the Equation 2, the current state x k of t is computed by multiplying 
the previous state model 0 k -i by the previous state x k -i. 

20 Further, in step S140, the first filter 441 outputs the first location information xl 

y 1 ' and 0 1' to the map-matching unit 450, and outputs the first location information xF, 

yl ' and 0 1 \ velocity information vl ' and PI to the third filter 443. Here, the PI is an 

error of the first location information xF, y F and 0 1 ' outputted from the first filter 441 . 

25 The map-matching unit 450 extracts the road linear information using the first 

location coordinate information xF, yF and 0 F. The method for extracting the road 

linear information in the map-matching unit 450 and detailed description of the road 
linear information will be described with reference to FIG. 10. Further, afterwards the 
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third filter 443 generates filter correction data, that is, optimum state computation 
information x m , error information P m , using the information xl\ yl\ vl\ 0 I'and PI 

inputted from the first filter 441 and a second location information x2', y2\ and 8 2', 

velocity information v2' and P2 inputted from the second filter 442. Then, the third 
5 filter 443 transmits it to the first filter 441. The method for generating the filter 
correction data, that is, optimum state computation information x m , error information P m , 
will be described with reference to FIG. 9. 

When the first filter 441 receives the filter correction data, including optimum 
10 state computation information x m , error information P m , from the third filter 443, which 
is the master filter, in step SI 50, the first filter 441 corrects the error of the GPS/DR filter 
model on the basis of the filter correction data, that is, optimum state computation 
information x m , error information P m , in step SI 60. The error of the GPS/DR filter 
model is corrected by the third filter 443 of master filter, the correction equation used for 
1 5 the correction is illustrated in Equation 3. 

[Equation 3] 

x k i+) = x k {~) + K k [z k -H k x k {-)] 
P k (+) = (I-KH)P k (-) 

20 Referring to the Equation 3, a gain K is obtained by using difference between the 

computed value x(-) computed in the first filter 441 and actual measured value Z^. 
Further, the final error P(+) is obtained by using the first error P(-) and the gain K. 

Equations 1 to 3 are typical equations used for predicting an optimum location 
25 and correcting an error using a Kalman filter; because the equations are known to those 
skilled in the art, more detailed description is omitted. 

Referring to FIG. 6 and FIG. 8a, an operation of the second filter 442 is described. 
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First, the second filter 442 receives DR sensor data, velocity v, and direction angle 

0 of the car, from the sensor 410 and receives road linear information from the mapO- 

matching unit 450 in step S210. In step S220, the second filter 442 initializes a map 
constraint filter for computing the second location information using the DR sensor data 
5 and the road linear information as measured value. 

When it is judged that the car is located on any road, information that can be 
obtained from the road is shown in the following Equation 4. 

10 [Equation 4] 

aX + bY = c 

In Equation 4, when a road section regarded as straight line is indicated on 
Transverse Mercartor (TM) coordinate system, the a, b and c correspond to coefficients 

15 of linear expression, respectively. Since the surface of the earth is curved, projection is 
necessary in order to indicate the earth on a flat surface like a map or screen. Here, a 
coordinate system obtained by TM projection of one kind of projective methods is called 
TM coordinate system. In the TM projection, three-dimensional coordinates are 
converted into two-dimensional coordinate by projecting the three-dimensional 

20 coordinates on an earth ellipsoid onto a cylinder, which surrounds the earth ellipsoid in 
such a manner that the cylinder extends in a transverse direction and is tangent to a 
reference point of the earth ellipsoid. The TM projection can conserve a size of angle, 
which is one of the most important conditions among general conditions of map 
projection, and its theory is general. Accordingly, a road map data used in a car 

25 navigation coordinate system typically applies the TM coordinate system obtained by TM 
projection. 

The map-matching unit 450 extracts such a coefficient of linear expression, for 
instance, a, b, c, and outputs it to the second filter 442. Here, the coefficient of linear 
30 expression comes under the road linear information. The second filter 442 initialize the 
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map constraint filter model using a, b, c. Here, the initialized map constraint filter 
model is shown in the following Equation 5. 

[Equation 5] 

z m = c-{aX DR +bY DR ) + v m 

= (aX + bY)-(aX DR +bY DR ) + v m 
5 = aS X + bSY + v m 

= [a 6 0 0 0 0]x + v w 

The Equation 5 is an equation calculating a measured model using a difference 
between the linear information C calculated in road model and actual sensor input Xdr 

• Y D r , and Equation 5 calculates as much as the difference between the road model and 

1 0 input value of the DR sensor. 

In Equation 5, v m represents an error of the road information and physically 
represents that a car is located at any position within a range of the width of the road from 
the center line of the road. Further, the v m should be computed as a white noise , and the 
1 5 size of the v m should be a value relating to the width of the road for using Kalman filter. 
As described above, the present invention more accurately computes the location of the 
car by using the map constraint filter including the error of the road information. 

FIG. 8b is a two dimensional line graph showing a relation between the error v m 
20 of the map information and the width of road, the fluctuation band of the value c for 
determining the width of road as shown in the Equation 4 is shown in the following 
Equation 6. 

[Equation 6] 

25 Ac = w-?— = -W— — 

sin 9 cos0 
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Further, when A c includes a relation between a, b of an coefficient of straight 

line and angle 0 , and a singular value of the sine function and cosine function, the A c 
is shown in Equation 7. 

[Equation 7] 

Ac = W^a 2 +b 2 

The v m representing the error of the map information is computed as the white 
noise having gauss distribution as shown in Equation 8. 

[Equation 8] 
v m ~N(0,R m ) 

In Equation 8, the R m is shown in the following Equation 9. 

[Equation 9] 
R m =W\a 2 +b 2 ) 

Accordingly, when the road information is used in an actual navigation system, 
the coefficients a and b may be represented as components of direction cosine of a vector 
since an equation of a straight line is calculated as a relational expression between two 
points on a road. In this case, the Equation 9 may be modified as the following 
Equation 10. 

[Equation 10] 

m 

The width of road W 2 obtained by using the Equations 6 to 10 is applied to an 
error in the measured model obtained by using the road linear model and DR sensor input. 
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That is, the second filter 442 of the map constraint filter computes the location 
information of the car by considering the width of the road W 2 as error. 

As described above, when the map constraint filter is initialized, the second filter 
5 442 applies the DR sensor data and the road linear information to the map constraint filter 
of the Equation 4 in order to compute the second location coordinates information x2\ 

y2\ 0 2' and velocity v2' in step S230 of FIG. 8a. Equation 2 shows an example of the 
method for computing the second location information x2\ y2', 0 2' in step S230. 

10 The second filter 442 outputs the second location coordinates information x2\ y2\ 

0 2', velocity v2' and P2 in step S240 (FIG.8a) to the third filter 443. In this case, the 

P2 is an error in regard to the second location coordinates information x2', y2 5 and 0 2' 
outputted from the second filter 442. 

15 The third filter 443 generates the filter correction data, that is, optimum state 

computation information x m , error information P m , using the first location coordinates 

information xl\ yl' and 0 1', velocity information vl' and PI previously inputted from 

the first filter 441 and the coordinates information x2\ y2', v2\ 0 2 'and P2 inputted 

from the second filter 442. Then, the third filter 443 transmits the filter correction data 
20 to the second filter 442. A method for generating the filter correction data, that is, 
optimum state computation information x m , error information P m , will be described 
below with reference to FIG. 9. 

When the filter correction data, such as, optimum state computation information 
25 x m , error information P m , is received in step S250 (FIG. 8a), the second filter 442 
corrects the error of the map constraint filter on the basis of the filter correction data in 
step S260 (FIG. 8a). A correction equation for correcting the error of the map constraint 
filter in step S260 (FIG. 8a) is shown in the Equation 3. 
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Referring to FIGs. 6 to 9, the operation of the third filter 443 is performed as 
follows. The third filter 443 receives the first location coordinates information of the 
car from the first filter 441 and the second location information of the car from the 
second filter 442 in step S3 10. In step S320, the third filter 443 computes final optimum 

5 location coordinates information x", y" and 0 " using the first location information and 

the second location coordinates information, and generates the filter correction data, that 

is, optimum state computation information x m = x", y" and 9 error information P m . 

A method for generating the filter correction data, such as, optimum state 
10 computation information x m , error information P m , in step S320 is shown in the 
following Equation 1 1 . 

[Equation 11] 

A A A A 

*m = Pm *l + ^ X 2 + # * * + Pa'' X N ] 

15 

Because two subfilters, the first filter 441 and the second filter 442, have been 
used instead of the master filter, i.e., the third filter 443, the value of 'N' is two in the 
Equation 11. Referring to the Equation 11, the filter correction data, such as, optimum 
state computation information x m , error information P m , is generated using the computed 
20 location coordinates information xi , x 2 and the errors PI, P2 inputted from the first filter 
441 and the second filter 442. 

The third filter 443 outputs the optimum location coordinates information x", y" 

and 0 " to the map matching unit 450 in step S330. Further, the third filter 443 outputs 

25 the filter correction data, such as optimum state computation information x m , error 
information P m , to the first filter 441 and the second filter 442 in step S340. Then, the 
first filter 441 and the second filter 442 correct the error of each filter using the filter 
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correction data, such as, optimum state computation information x m , error information 

The map matching unit 450 has two functions. First, the map matching unit 450 
5 extracts the road linear information including road error in response to the first location 

information xl\ yl' and 0 1' of the car transmitted from the first filter 441 and 

transmits the road linear information to the second filter 442. Second, the map matching 
unit 450 performs map-matching in response to the optimum location information x", y" 

and 0 " of the car transmitted from the third filter 443. The latter is similar to the 

10 function of a conventional map matching unit. 

Referring to FIG. 6 to FIG. 10, the operation of the map matching unit 450 is as 

follows. First, the first location information xl\ yl' and 0 V is transmitted from the 

first filter 441 in step S410. Then, the map matching unit 450 detects link information 
15 and node information of the digital map previously stored in the memory 430 in step 
S420 and extracts the road linear information on the basis of link information and node 
information in step S430. 

For instance, when it is judged that the car is located on some road, information, 
20 which may be obtained from the road is shown in the following Equation 12. 

[Equation 12] 
aX + bY = c 

25 In Equation 12, parameters a, b and c correspond to the coefficient of linear 

expression respectively when a road section regarded as straight line is indicated on the 
TM coordinate system. The map matching unit 450 extracts the coefficients of the 
linear expression such as a, b and c and outputs them to the second filter 442 in step S440. 
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Also, the optimum location coordinates information x", y" and 0 "is 

transmitted from the second filter 443 in step S450. Then, the map matching unit 450 
detects the link information and node information of digital map stored already in the 
memory 430 in step S460. In step S470, it is judged whether the location inputted in 
5 step S450 on the basis of the link information and node information is a crossroads or not. 
In judging whether the computed location is a crossroads or not, an existence of a 
crossroad within a predetermined distance may be detected using a forward node 
information and link information. Also, it can be determined that the computed location 
is a crossroads when a trace of the car calculated from the GPS/DR integrated filter 
1 0 passes a node of the crossroads or when a measured attitude angle has a large difference 
from a direction angle of the current computed road, without regard to the fact that the 
trace has not passed yet, or has already passed. 

From the judgment in step S470, if the location computed in step S450 is a 
15 crossroads, a link of an adjacent crossroads is selected in step S480. If not, a link of the 
shortest distance from the computed location is selected in step S490. In this case, the 
selected link becomes matched map information about the computed location coordinates 
information. 

20 As described above, when the map-matching has been performed about the 

computed location coordinates information, x and y coordinate corresponding to the 
matched link are calculated in step S500. Then, the map matching unit 450 outputs the 
location information so that the location information of the car can be indicated at a 
corresponding location in step S510. 

25 

The method for detecting location of a car illustrated in FIGs. 6 to 10 is 
incorporated in FIG. 11. FIG. 11 is a flow chart illustrating a method for detecting a 
location of the car in a car navigation system according to an embodiment of the present 
invention. Referring to FIG. 11, the sensor data including location coordinates 
30 information and direction information of the car is inputted from sensors installed on the 
car navigation system in step S610. Then, the car navigation system initializes the 
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GPS/DR filter model to compute the first location information from the sensor data in 
step S620, and computes the first location information by means of the GPS/DR filter 
model in step S630. The GPS/DR filter model initialized in step S620 is shown in 
Equation 1. Further, a method for computing the first location information of the car by 
5 means of the GPS/DR filter model is as shown in Equation 2. 

As described above, when the first location information of the car is computed, 
the car navigation system extracts the road linear information by means of the first 
location information in step S640. Here, the extracted road linear information 
10 represents coefficients of linear expression shown in Equation 4. 

The car navigation system initializes the map constraint filter model on the basis 
of the extracted road linear information in step S650, and computes the second location 
information by means of the map constraint filter model in step S660. In this case, the 
15 map constraint filter model initialized in step S650 is shown in Equation 5. Further, a 
method for computing the second location information of the car by means of such a map 
constraint filter model is shown in Equation 2. 

As described above, when the first and the second location information of the car 
20 are computed, the car navigation system computes the optimum location information of 
the car by means of the first and the second location information in step S670. Further, 
the car navigation system generates the filter correction data for correcting the GPS/DR 
filter model and the map constraint filter model in step S680. In this case, a method for 
generating the filter data is shown in Equation 1 1 . 

25 

Further, in order to determine final location information of the car, the optimum 
location information of the car computed in step S670 is transmitted to the map matching 
unit in step S690. And, in step S700, the GPS/DR filter model and the map constraint 
filter model are corrected using filter correction data generated in step S680. 
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As described above, the present invention can apply a constraint to location of the 
car by computing the location of the car including a width of road after applying the map 
constraint filter to the second filter in comparison with a case using only the direction of 
road as a measured value. Further, the present invention can increase accuracy of 
5 location determination for the car by performing real-time correction of sensor 
information including an error whenever the sensor information is inputted, using the 
constraint model including the map information. Further, the present invention can 
provide more actual location information in that the error component included in the 
measured value has a physical meaning related to the actual width of road. Accordingly, 
10 the present invention can provide more accurate information to a driver in the car 
navigation system providing driver with a guidance message on the basis of current 
location information of the car. 

While the invention has been shown and described with reference to certain 
15 preferred embodiments thereof, it will be understood by those skilled in the art that 
various changes in form and details may be made therein without departing from the 
spirit and scope of the invention as defined by the appended claims. 
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